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(57) Abstract: Two GPS units (18, 20) are mounted at two separate points on the body (12) of a work machine (10) to periodically 
measure their three-dimensional coordinates with respect to a chosen reference system. A plane is fitted through four points so 
collected and it is used to deterrnine the current orientation of the machine. As each additional set of position data is collected at 
predetermined intervals for the two points on the machine, a new plane equation is calculated to update the orientation of the machine 
based on a predetermined number of prior measurements. Standard-deviation analysis is used to check the validity of each plane 
calculation. Based on the current coordinates of the two GPS antennas, the current orientation plane so calculated, and the known 
geometry of the work machine, the current position of its critical components (14, 16) can be determined as well. 
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TWO-ANTENNA POSITIONING SYSTEM 
BACKGROUND OF THE INVENTION 

5 

Field of the Invention 

This invention is related in general to the field of 
equipment automated control and, in particular, to a 
system for determining the position and orientation of 
10 various components of a work machine operating on the 
grounds of a surface mine. 

Description of the Related Art 

Surface mines utilize a variety of work machines for 
15 excavating and transporting ore, grading and stabilizing 
roadways and slopes in the mine pit, and providing all 
support functions necessary to the operation of a mine . 
Most work machines, such as excavators, shovels, backhoes 
and the like, are human-operated, mobile pieces of 
20 equipment constantly being moved around on the surface of 
the mine. Skilled operators ensure that each work machine 
is positioned in the right place and optimally oriented to 
perform its intended function. For example, an excavator 
operator will ensure that the undercarriage of the machine 
25 is sufficiently close to the minable seam and that its 

boom is oriented so as to permit the bucket of the machine 
to reach and extract a full load of ore. 

In order to improve safety and efficiency, much effort is 
3 0 currently under way to develop automated systems for 

controlling the operation of work machines in surface-mine 
and other environments. The ability to determine the 
exact position of critical components of a working 
machine, such as the bucket of an excavator, is a very 
35 important feature of any such effort to automate certain 
aspects of a mining operation. Accordingly, various 
positioning systems have been developed in this and 
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related arts based on the properties of various 
triangulation tools such as lasers, radio, microwave, 
radar, and the Global Positioning System (GPS). 

5 For example, in U.S. Patent No. 5,438,771, Sahm et al . 
describe a system for determining the location and 
orientation of a work machine having a fixed undercarriage 
supporting a car body rotatably connected to it. The 
system utilizes a GPS unit placed on the car body at a 

10 place removed from its axis of rotation. By collecting at 
least three coordinate positions of the GPS antenna as the 
car body rotates over its stationary undercarriage, the 
plane corresponding to the orientation of the machine and 
the position of the axis of rotation can be calculated. 

15 Based on these data, the current position of the GPS 

antenna, and the geometry of the machine, the position and 
orientation of every critical component of the machine can 
be determined and used for controlling its operation. 

20 Because of the requirement that at least three positions 
of the GPS antenna be recorded along an arc of rotation, 
the system disclosed in the 7 771 patent is only applicable 
to work machines that include a rotating body over a 
transport undercarriage. In addition, the system requires 

25 that the undercarriage be kept stationary during 
measurements and that at least three data points be 
collected before the plane of orientation can be 
determined every time the work machine is moved to a new 
work site. Therefore, this method and apparatus are not 

30 suitable for continuous tracking of the position of mine 
vehicles or for controlling equipment lacking a rotating 
body. The present invention provides a procedure and 
apparatus that overcome these deficiencies. 
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BRIEF SUMMARY OF THE INVENTION 

The primary objective of this invention is a method and 
apparatus for determining the position and orientation of 
5 critical components of a work machine operating on the 
surface of a work site. 

Another important goal of the invention is a system of 
general application to all kinds of equipment, 
10 irrespective of their specific geometry and whether or not 
they include a rotating component. 

Another objective is a system that provides continuous 
position and orientation information while the work 
15 machine is stationary as well as when it is moving along 
the surface of the work site. 

Another goal is a system that can be implemented in 
conjunction with conventional control algorithms and/or 
20 hardware. 

Still another objective is a system that is suitable for 
incorporation within existing work-machine 
instrumentation . 

25 

A final objective is a system that can be implemented 
easily and economically according to the above-stated 
criteria. 

30 Therefore, according to these and other objectives, the 
preferred embodiment of the present invention consists of 
utilizing two GPS units judiciously mounted at two 
separate points on the body of a work machine to 
periodically measure their three-dimensional coordinates 

35 with respect to a chosen reference system. As soon as two 
sets of measurements are recorded, a plane is fitted 
through the four points so collected and it is used to 
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determine the current orientation of the machine. As each 
additional set of position data is collected for the two 
points on the machine at predetermined intervals , a new 
plane equation is calculated to update the orientation of 
5 the machine based on a predetermined number of prior 
measurements. Standard-deviation analysis is used to 
check the validity of each plane calculation and the 
process is restarted when the deviation is found to be 
greater than an acceptable parameter. Based on the 
10 current coordinates of the two GPS antennas, the current 
orientation plane so calculated, and the known geometry of 
the work machine, the current position of its critical 
components can be determined as well irrespective of the 
specific motion pattern of the machine. 

15 

Various other purposes and advantages of the invention 
will become clear from its description in the 
specification that follows and from the novel features 
particularly pointed out in the appended claims. 

20 Therefore, to the accomplishment of the objectives 

described above, this invention consists of the features 
hereinafter illustrated in the drawings, fully described 
in the detailed description of the preferred embodiment 
and particularly pointed out in the claims. However, such 

25 drawings and description disclose but one of the various 
ways in which the invention may be practiced. 

BRIEF DESCRIPTION OF THE DRAWINGS 

30 

Fig. 1 is a schematic plan view of a conventional 
excavator illustrating the placement of two GPS units 
according to the invention. 

35 Fig. 2 shows a flow diagram detailing the computational 
steps of the invention. 
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DESCRIPTION OF THE PREFERRED EMBODIMENTS OF THE INVENTION 

The present invention consists of a novel two-antenna 
positioning system and a corresponding computational 
5 algorithm for ascertaining the position and orientation of 
a mobile machine on the surface of a work site, such as 
the pit of a surface mine. The algorithm is based on the 
periodic collection of position data for two known points 
on the body of the machine where positioning apparatus is 

10 mounted. Accordingly, the invention requires two 

positioning-system units dedicated to provide current 
coordinate data for these two points. The preferred 
embodiment of the invention utilizes GPS units, but is 
understood that any other technology capable of 

15 determining the three-dimensional position of a selected 
point on the work machine is suitable for practicing the 
invention. 



Referring to the drawings, wherein like parts are 

20 designated throughout with like numerals and symbols, Fig. 
1 illustrates in plan view a conventional machine 10, such 
as a shovel-type excavator, used in surface mining 
operations. Such equipment includes a car body 12 mounted 
on an undercarriage (not shown) for moving the machine 

25 within the work site, an articulated boom 14, and a shovel 
bucket 16. In order to optimize the production cycle of 
the machine, it is desirable to keep track of the current 
location and orientation of some critical component of the 
excavator, in particular the position of the shovel bucket 

30 16. According to the invention, two GPS units 18 and 20 
are rigidly mounted on the car body 12 at two known 
locations (shown by reference numerals 1 and 2, 
corresponding to the position of the units 18,20). In 
order to optimize the accuracy of measurement, the units 

35 are preferably separated by as much distance as possible, 
and in any event by more than twice the resolution of the 
GPS system. As would be obvious to one skilled in the 
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art, each GPS unit and its antenna needs to be placed at a 
location on the body 12 where it can be shielded by a 
protective structure and is less likely to suffer damage 
from the hardship of normal mining operation. One of the 
5 front corners of the car body 12 (shown as point 1 by a 
reference arrow, where unit 18 is located) and the 
rearmost point along the main horizontal axis Al of the 
machine 10 (point 2, unit 20) are preferred in the case of 
an excavator-type machine 10. 

10 

Using standard GPS operation, the coordinates of points 1 
and 2 are determined periodically to locate the machine 10 
with reference to a predetermined x,y,z coordinate system 
(z being the vertical direction) having an origin O 

15 appropriately selected for practicing the invention, such 
as corresponding to a recognizable monument 22 at a mine 
site. After a first measurement is taken, the exact 
spatial position of points 1 and 2 is known, but the 
orientation of the car body 12 remains unresolved because 

20 of the infinite positions the car body may assume 

depending on its degree of rotation around the axis A2 
passing through points 1 and 2. Therefore, more 
information is needed to establish the tilt of the machine 
10 with respect to such axis. 

25 

As used herein, the term orientation is intended to refer 
to the pitch and roll of the machine 10 with respect to a 
known reference plane, such as a horizontal plane, where 
pitch and roll refer to angular deviations from the x,y 

30 axes of the reference plane, respectively, or vice versa. 
It is also understood that a premise of the invention is 
that the machine 10 is sufficiently rigid to suffer 
negligible structural deformation during normal use, so 
that the location of any component can be determined with 

35 confidence once the position of points 1 and 2 and the 
orientation of the car body 12 is established. As 
detailed in prior-art disclosures, the determination of 
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the position of any part that is movable with respect to 
the car body 12 (such as the extendable boom 14 and the 
bucket 16 pivotally attached to it) must account for such 
relative movement and change in the overall geometry of 
5 the machine. Appropriate devices to measure and keep 

track of such relative movements, such as linkage position 
sensors (angle and tilt), are available in the art and the 
algorithm of the invention has simply to account for such 
additional three-dimensional displacements using apparatus 
10 and procedures that are also well known by those skilled 
in the art. 

According to one aspect of the invention, as the machine 
10 moves around the surface of a work site, the position 

15 of points 1 and 2 is measured at predetermined time 

intervals, which may be periodic or not. According to 
another aspect, a plane equation is fitted by conventional 
least-squares techniques through a selected number of most 
recent measurement data points. In the preferred 

20 embodiment, we found that 20 such measurement sets provide 
a suitable data base for estimating the current 
orientation of the machine 10. Thus, as soon as two sets 
of data are collected from the GPS units 18,20 (four 
points in space) , a plane equation is fitted through them 

25 and its orientation with respect to a horizontal plane is 
accepted as the orientation of the machine 10. In order 
to ensure the reliability of each new set of measurements, 
the standard deviation of the data used to fit the current 
plane equation is calculated and the equation is rejected 

3 0 if the standard deviation is greater than a predetermined 
value. In such case, the procedure is restarted and a new 
plane equation is calculated with the current and next 
sets of data collected through the GPS units, so that 
updated position information is skipped for one time 

35 interval only. 



Thus, after each set of position measurements [(x 1# y lf z x ) 
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and (x 2 , y 2 , z 2 )] for points 1 and 2 is obtained, the 
system of the invention also determines the corresponding 
current pitch and roll of the machine with respect to the 
horizontal plane, based on which the current position of 
5 any machine component can be ascertained. Using standard 
least-squares surface fitting techniques, a plane equation 
having the general form z = ax + by + c is derived for the 
plane that best fits the last n sets of position data for 
the two points 1 and 2, where n is judiciously chosen to 

10 provide a computationally efficient algorithm. From basic 
mathematical principles, it is known that the coefficients 
a and b of the plane equation represent the slopes of the 
plane with respect to the x and y axes, respectively; for 
the purposes of the invention, these slopes are also 

15 defined as the pitch and roll of the plane with respect to 
the horizontal plane z = 0 passing through the origin 22 
of the reference coordinate system selected for locating 
the machine 10. The orientation of the machine with 
respect to the horizontal plane is taken to be the same as 

20 that of the currently-calculated plane equation. Thus, 
the last recorded spatial coordinates of the points 1 and 
2 and the slope parameters of the current plane equation 
define the current position of the car body 12 with 
respect to the reference point 22, such that the location 

25 and orientation of the machine within the mine are known 
and can be used for control and process optimization 
purposes . 

As mentioned, once the position of the car body 12 of the 
30 machine 10 is established in space, the machine's geometry 
and the history of any relative motion of machine 
components make it possible to determine the current 
position of any such component of interest, which can then 
be utilized for improving operating performance. For 
35 instance, the position of the shovel 16 can be shown on a 
monitor that also indicates the location of a target 
mining site, so that an operator of the excavator 10 need 
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not rely on surface markers to identify ore boundaries. 
Similarly, the system of the invention could be used to 
direct the placement of automated haulage equipment within 
reach of the excavator's bucket for loading after 
5 completion of a mining cycle. 

Fig. 2 illustrates in flow-diagram form the computational 
steps of the invention detailed above. Obviously, a data 
processing system 24 must be provided to enable the 

10 computations required to determine the position of the 
work machine 10 to occur in real time. Such processing 
system preferably consists of a microprocessor, or a 
personal computer including a CPU, coupled to a data 
storage medium and a logic circuit or other programmed 

15 component that performs a series of specifically 

identified operations to implement the procedure of the 
invention. In the preferred embodiment, the current set 
of spatial coordinates is recorded periodically from the 
GPS units at 1/2- to 2-second intervals; 20 most recent 

20 sets of data are retained for the fitting step that 

produces the current plane equation used to determine the 
pitch and roll of the machine 10; and a maximum standard 
deviation a of 30 cm is tolerated, otherwise the plane 
fitting routine is restarted. Two GPS units Model No. 

25 GG24 manufactured by Ashtech Precision Products (Magellan 
Corporation) of Santa Clara, California, have been used as 
indicated in Fig. 1 and spaced apart a distance of 15.5 
meters. These units provide coordinate information with 
an average accuracy within 3 cm, which in turn has 

30 produced position measurements for the machine 10 with a 
spatial accuracy of 10 cm and an orientation accuracy 
within 0.20 degrees of rotation with respect to the axis 
A2 passing through points 1 and 2 . 

35 The advantages of the invention could be obtained as well 
by using any positioning system capable of providing rapid 
and accurate three-dimensional coordinate information at 



WO 00/74272 PCT/US00/14168 

10 

predetermined time intervals for any two points on the 
work machine. Moreover, because the orientation 
parameters are obtained by fitting a surface equation to 
coordinate data collected over several periods of time, 
5 equivalent results would be obtained by measuring the 

coordinates of points 1 and 2 at different times; that is, 
concurrent measurements are not critical to the invention. 
Similarly, numerical techniques other than least-squares 
regression could be used to fit the plane equation through 

10 the spatial coordinates sequentially identified by the 
travel trajectory of points 1 and 2. Finally, a surface 
equation other than that of a plane could also be used to 
determine the current orientation of the work machine; for 
example, the equation of a spherical surface. In such 

15 case, the pitch and roll parameters of the plane tangent 
to the sphere at the current position of either point 1 or 
2 would yield accurate orientation information for the 
machine. It is expected that such determination would be 
even more precise than the information derived simply from 

20 the plane equation, but it would not be preferred because 
of the added computational complications which are not 
warranted in light of the excellent results obtained with 
the procedure illustrated above. 

25 The foregoing illustrates that the system of the invention 
is not dependent on the rotation of the car body 12 or any 
other component with respect to an undercarriage. 
Therefore, it is suitable for use with equipment that does 
not feature such functional characteristic. Moreover, the 

30 method of the invention requires only two measurements 
before current position information is provided and 
position updates continue to be available at predetermined 
time intervals whether or not the work machine is 
traveling within the work site. 

35 

It is noted that the invention has been described with 
reference to x, y and z orthogonal coordinates wherein x 
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and y define a horizontal plane and z defines a vertical 
direction, but it is obvious that the structure and 
operation of the features detailed above could be rotated 
in any direction with equivalent results. Similarly, a 
5 different coordinate system could be used, as would be 
obvious to one skilled in the art. It is also understood 
that the various components shown in the drawings are not 
drawn to relative scale, but they are represented only 
schematically for illustration. 

10 

Various changes in the details, steps and components that 
have been described may be made by those skilled in the 
art within the principles and scope of the invention 
herein illustrated and defined in the appended claims. 

15 Therefore, while the present invention has been shown and 
described herein in what is believed to be the most 
practical and preferred embodiments, it is recognized that 
departures can be made therefrom within the scope of the 
invention, which is not to be limited to the details 

20 disclosed herein but is to be accorded the full scope of 
the claims so as to embrace any and all equivalent 
apparatus and processes. 
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1. A method for determining the spatial location and 
orientation of a work machine having a known geometry, 

5 comprising the following steps: 

(a) determining spatial coordinates of a first point 
on the work machine corresponding to a position along a 
trajectory traveled by said first point in three- 
dimensional space ; 
10 (b) determining spatial coordinates of a second point 

on the work machine corresponding to a position along a 
trajectory traveled by said second point in three- 
dimensional space ; 

(c) repeating steps (a) and (b) a predetermined 

15 number of times to produce a plurality of said coordinates 
of the first and second points on the work machine 
corresponding to successive positions along said 
trajectories traveled in three-dimensional space; 

(d) fitting a surface equation through said plurality 
20 of coordinates and determining orientation parameters for 

the surface equation so produced; and 

(e) calculating a spatial location and orientation 
parameters of the work machine utilizing current spatial 
coordinates for said first and second points on the work 

25 machine, the orientation parameters of the surface 

equation calculated in step (d), and the known geometry of 
the work machine. 

2. The method of Claim 1, further including the following 
30 step: 

(f) successively repeating steps (a), (b) , (d) and 
(e) to determine current coordinates of said first and a 
second points on the work machine; to produce a current 
plurality of said coordinates of the first and second 

35 points on the work machine based on a predetermined number 
of most recent measurements; to fit a current surface 
equation through said current plurality of coordinates; to 
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determine current orientation parameters for the current 
surface equation so produced in step (d) ; and to calculate 
a current spatial location and current orientation 
parameters of the work machine utilizing current spatial 
5 coordinates for the first and second points on the work 
machine, the current orientation parameters of the surface 
equation, and the known geometry of the work machine. 

3 . The method of Claim 1 , further including the steps of : 
10 calculating a standard deviation for said plurality 

of coordinates used in step (d); 

comparing the standard deviation to a predetermined 
parameter ; 

if the standard deviation is smaller than said 
15 predetermined parameter, continuing to step (e); 

if the standard deviation is equal to or greater than 
said predetermined parameter, repeating steps (a) and (b) 
at least once to produce a new plurality of said 
coordinates of the first and second points on the work 
20 machine corresponding to successive positions along said 
trajectories traveled in three-dimensional space; and 

continuing with step (d) using said new plurality of 
coordinates . 

25 4. The method of Claim 2, further including the steps of: 
calculating a standard deviation for said plurality 

of coordinates used in step (d); 

comparing the standard deviation to a predetermined 

parameter ; 

30 if the standard deviation is smaller than said 

predetermined parameter, continuing to step (e); 

if the standard deviation is equal to or greater than 
said predetermined parameter, repeating steps (a) and (b) 
at least once to produce a new plurality of said 

35 coordinates of the first and second points on the work 
machine corresponding to successive positions along said 
trajectories traveled in three-dimensional space; and 
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continuing with step (d) using said new plurality of 
coordinates . 



5. The method of Claim 1, wherein at least one of said 
5 steps (a) and (b) is carried out using a global- 

positioning-system unit. 

6. The method of Claim 1, wherein said surface equation 
in step (d) is a plane equation. 

10 

7. The method of Claim 1, wherein said step (d) is 
carried out using linear regression. 

8. The method of Claim 6, wherein said step (d) is 
15 carried out using linear regression. 

9. The method of Claim 1, wherein said predetermined 
number of times in step (c) is at least two. 

20 10. The method of Claim 2, wherein said predetermined 
number of most recent measurements is twenty. 

11. The method of Claim 1, wherein said predetermined 
parameter is 30 cm. 

25 

12. A method for determining the spatial location and 
orientation of a work machine having a known geometry, 
comprising: 

(a) determining a plurality of coordinates of a first 
30 point on the work machine corresponding to successive 

positions along a trajectory traveled by said first point 
in three-dimensional space; 

(b) determining a plurality of coordinates of a 
second point on the work machine corresponding to 

35 successive positions along a trajectory traveled by said 
second point in three-dimensional space; 

(c) fitting a surface equation through said plurality 
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of coordinates determined in steps (a) and (b) ; and 

(d) calculating a spatial location and orientation 
parameters of the work machine on the basis of current 
coordinates of said first and second points on the work 
5 machine, orientation parameters of said surface equation, 
and said known geometry of the work machine. 

13. The method of Claim 12, wherein at least one of said 
steps (a) and (b) is carried out using a global- 

10 positioning-system unit. 

14. The method of Claim 12, wherein said surface equation 
in step (c) is a plane equation. 

15 15. The method of Claim 12, wherein said step (c) is 
carried out using linear regression. 

16 . An apparatus for determining the spatial location and 
orientation of a work machine having a known geometry, 

20 comprising: 

first means for determining position coordinates of a 
first point on the work machine in three-dimensional space 
at successive times corresponding to successive positions 
along a travel trajectory of said first point; 

25 second means for determining position coordinates of 

a second point on the work machine in three-dimensional 
space at successive times corresponding to successive 
positions along a travel trajectory of said second point; 
means for storing a plurality of said position 

30 coordinates of the first and second points on the work 
machine; 

means for fitting a surface equation through said 
plurality of position coordinates of the first and second 
points on the work machine and for determining orientation 
3 5 parameters for said surface equation; and 

means for calculating a spatial location and 
orientation of the work machine utilizing a current set of 
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position coordinates for said first and second points on 
the work machine, the orientation parameters corresponding 
to a current surface equation, and the known geometry of 
the work machine, 

5 

17. The apparatus of Claim 16, wherein at least one of 
said first and second means for determining position 
coordinates includes a global-positioning-system unit. 

10 18. The apparatus of Claim 16, wherein said means for 

fitting a surface equation includes means for implementing 
linear regression on said plurality of position 
coordinates . 

15 19. The apparatus of Claim 16, wherein said surface 
equation is a plane equation. 



20. The apparatus of Claim 18, wherein said surface 
equation is a plane equation. 

20 



WO 00/74272 



1/2 



PCT/US00/14168 



+y 




+X 



FIG 1 



WO 00/74272 



PCT/US00/14168 



2/2 



Begin Procedure for Determining Spatial Coordinates of 
Points of Interest on Work Machine — Set Time T = t 



Measure and Record Current Spatial Coordinates, 
(xj, yj, Zj) T and (x 2 , y 2 » Provided b Y Gp S Units 

for Known Points 1 and 2 on Work Machine 



After Predetermined Time Interval At, set T = t + At 



Measure and Record Current Spatial Coordinates, (xj, yj, Zj) T and (x 2 , 
y 2 , z 2 ) T , Provided by GPS Units for Points 1 and 2 on Work Machine 



Fit Plane Equation Through n Most Recent Sets 
of Spatial Coordinates for Points 1 and 2 



Calculate Standard Deviation a of n Most Recent Sets 
of Spatial Coordinates for Points 1 and 2 
with Respect to Corresponding Plane Equation 



No 




Calculate Spatial Position of Point of Interest on Work Machine Based on 
Current Set of Spatial Coordinates for Points 1 and 2, (xj, y 1? Zj) T and (x 2 , y 2 , 

z 2 ) T , Parameters of Current Plane Equation, and Geometry of Work Machine 

If Work Machine Includes Articulated Parts, 
Account for Relative Movements Thereof 



Input Spatial Position of Point of Interest on Work Machine 
into Post-Calculation Process-Activity Apparatus 
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